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(54) WALKING CONTROL DEVICE FOR LEG TYPE MOBILE ROBOT 

(57)Abstract: 

PURPOSE: To easily realize posture stabilizing control 
by providing a means for detecting the actual inclination 
and/or actual inclination speed of a robot and a means 
for comparing the detected value with an instructed 
value to determine the deviation. 

CONSTITUTION: The output of an inclination sensor 40 
is transmitted to a RAM 54 through a bus 52. The output 
of an encoder arranged adjacent to each electric motor 
is inputted to the RAM 54 through a counter, and the 
output of grounding switch 38 is similarly stored in the 
RAM 54 through a waveform shaping circuit 58. A 
control unit 26 has first and second arithmetic devices 
60, 62 consisting of CPUs, and the first arithmetic 
device 60 calculates the joint driving pattern of a target 
joint angle and transmits it to the RAM 54. The second 
arithmetic device 62 reads the target value and the 
detected actual measurement value, calculates a control 
value necessary for driving each joint and outputs it to 
the electric motor for driving each joint. 
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m<Dmmi or. i ol (^hsi^r. ^EW^Li^s. 
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LVm^Stli>, CC-C. fflieP';>i'2l3:SS©JEK-o 
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y. Fz i-e©:^**>D©*-->'> h^^Mx. M 

y. Mzt^mML. ^s^(Dmm<ommf^mmicmt> 
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pm^*5*f<ai^^^-c^snri.^si&«. !^*^-r 

Pj ». J«S*{cJ:**->>h*s«i^tej3cffi±©* 
. ;^lJt?S 1 4{C*Jl>-CSqi*llii©!Rfit* 
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C©«|{C. S 1 0*i6S 1 8»»$l^^* 
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mmmtmi^ri>!^\t. zMPgms3!»6jat,»fflij©s 
40 6. Hiscc^-racc. ai,»wj©js¥©iiisj^s±©^ 

IftftSe 1*> ifiC»W©JS¥©-e-n0 2{Cl:bL. /h3< 
L/C. laj. a¥©IB«)^ffi?:^2j|iSeiI{Cfi£r>/c*i. ^ 
ill*SM©±T«i«:-:>i,>rfeS^-r4*»©-c*<5. *fc 

[ 0 0 4 0 ] 0 1 9 » c©^Bj©|| 7 mi&V^^m *s 

«a-rsfc©-c$.s. Bu^. mi^<Dmmmitmnyjf^, m 
ianii*?ii»-rs'i>©-c*o/c*v c©j|jst^©jt^. it 

50 :^|SI (xttStoO) ©*->>hMx4>^HiUr*iJ'^fii 



u 



C7) 



[0 04 1 ] 02Ot3:C©^?B®»8jliS0!l*^L-C*J 
•3. ir4SI*6W{CRI0r^U/cEll 4©ytat.i'«Ha{C 



5-305579 

12 

: <1+TS) {/c/cL. TWRJ^I^) i-T^S, ^{>i:3> 

mm{c— seot:> a7j<-y hi^ioracDtss^ft 

[0 04 2] 



- 1 



1/Kl«g + Kf / (1 + TS) 



[0043] 1 e g*s+^iSwntf , 1 /K I 

[0044] 
[*Jt3] 



[0 04 5] cn«. 02 UC^-r^tC. 

7 T >;^«m©SSS*i«S 0 . feM*P;5 <- c i *s 

[0 04 6] li|2 2i:cC»0ia2 8»C©#&|§©||g||$ll 

[0047 ] ffii^Kin*r > hcc*jc»-c. Mg5^^ti$iJ 
*tf*)^j:C»<b*. *^tf4'©MW3t^Xg«:^^*i^O-Cfc 

t(r(c«<i. f^flPj©s^3isj**»68in-r^?ws*iB!rffliJ© 
{c±^*©^^l^*-^>(,^ifi-c^©■rn*MW©a<l#{c7 ^ - 
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^ct^iHifiiJcaja 0/c i ^ *>^©flBn4S;tjm ■set 
Ai-cs-ciathiiijio ©^4«i#-r-s c iJtdr* St* 
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